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(54) Title: EQUIPMENT FOR CONTROLLING AN INDUSTRIAL ROBOT AND A METHOD FOR PROGRAMMING AND/OR 
ADJUSTING THE MOVEMENTS OF THE ROBOT 

(57) Abstract 

An equipment for 
controlling an industrial robot, 
which robot has a plurality 
of rotation and/or translation 
axles (ax 1-6), comprising 
a motor (15) at each of said 
axles for generating desired 
movements of the arms and/or 
the wrist, of which the robot 
is constituted, a sensor at each 
of the axles for measuring axle 
angle and/or axle position, a 
servo (9) for each of the axles 
for controlling the motors 
based on measurement values 
from the sensors, and a path 
generator (8) for generating at 
least one reference (<f> T cf* #ref» 
rffw) for each of the servos (9). 
The equipment comprises an 
apparatus ( 1 +2+3+4+5+6+7+ 
parts of 8+18A+18B) at at 
least one of the axles, which 
apparatus comprises a first 
device (18A) for calculation 
of the expected interference 




moment 



value (rdistcxo) of said axle when the movable parts of the robot is not exposed to any external forces by interaction with 



the 



operator (64) or other things in the surroundings of the robot, and a second device (18B) for comparing this expected interference moment 
value (r distexD ) with values of the moment reference (r mr ) of the servo (9) and/or with values of the moment (r m ) of the motor and/or with 
values of the moment of the axle (14) and for forming, based on this comparison, a signal (r con tro0 for controlling the path generator (8). 
A method for programming/adjusting the movement of a robot is also included. 
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Equipment for controlling an industrial robot and a 
method for programming and/or adjusting the movements 
of the robot. 

Field of the invention 



This invention relates to an equipment for controlling an indus- 
trial robot according to the preamble of the subsequent claim 1. 
15 Furthermore, the invention relates to a method for programming 
and/or adjusting the movement of a robot according to the pre- 
amble of claim 18. 



PRIOR ART 



20 



An industrial robot comprises several arms, which are moveable 
in relation to each other, and a holder designed for mounting of 
the tool, object or gripping appliance, which the robot is to han- 
dle The industrial robot is provided with a control system, which 
25 controls position and orientation of the tool/object/gripping ap- 
pliance and for each of the movement axles of the robot there is 
a servo system with a driving motor. The servo system of each 
axle is supplied with a reference value (desired valued) for the 
rotation angle of the axle and the driving motor of the axle 
30 makes the manipulator move in the axle in question until the 
axle position corresponds with the reference value supplied to 
the servo system. With an axle is here meant axle transmis- 
sions, which can cause rotation as well as translation of the 
moveable arms of the robot. 
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The industrial robots of today are programmed either off-line or 
on-line by so called teach-in. During programming in teach-.n 
the reference values to the servo systems of the axles are gen- 
erated from a so called interpolator, which interpolates a path 
5 for the tool of the robot based on the signals from press-buttons 
or a control stick located on a particular programming unit. Th.s 
teach-in technique has the following drawbacks: 

it is difficult to know which movement the object carried by 
10 the robot obtains at a given button pressing/control st.ck 
movement; 

it is difficult to control the object movements when the object 
by touching its surroundings is exposed to forces from differ- 
15 ent directions. In this direction, there is a very great risk that 
the control system disengages due to obtainal of too large 
motor moments; 

it is difficult to manipulate objects which are partly concealed 
20 by surrounding equipment; 

it is difficult to obtain smooth movement patterns, since it is 
difficult to control 6 degrees of freedom simultaneously by 
means of a control stick. Therefor, the position of the objec 
25 is normally programmed separately from the programming of 
the orientation of the object, which makes it difficult to obtain 
for instance an effective distribution of the reorientat.on be- 
tween programmed positions, at the same time as the 
switching technique is time-consuming. 



30 



Object of the invention 



35 



The present invention aims at providing a technique which 
solves the above mentioned problems in teach-in and which at 
the same time makes the programming much more simple and 
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faster, in particular in applications such as assemblage, disas- 
sembly and advanced material handling. 

Summary of the invention 

According to the invention, this object is achieved by the fea- 
tures which are more closely defined, concerning the equipment, 
in the characteristics of claim 1 and, concerning the method, in 
the characteristics of claim 18. 

Advantageous developments of the basic inventional idea are 
the object of the dependent claims. 

The invention is based on a servo with a high sensitivity to ex- 
15 ternal forces on robot-arms, tool, object and gripping appliance. 
These forces causes, in the servo systems of the axles, regula- 
tion of the motor moments, and by means of a particular func- 
tionality in each axle servo a moment control of the reference 
values to the servo is obtained. This implies that if for instance 
20 the operator takes in his hand the object carried by the robot 
• and moves and rotates it, the robot will follow the movements of 
the object and at the same time support it even though it is very 
heavy. For the operator, the object will in this way become 
weightless during the programming. 

With this technique, the object will fully follow the intentions of 
the operator without the operator having to keep a check on re- 
lations between for instance control stick directions and the 
movement direction/rotation axle of the object. When the object 

30 is to touch its surroundings, which is always the case during as- 
semblage the robot can never obtain to high motor moments, 
since the moment will decrease instead of increase during inter- 
action between object/robot and the surroundings. Furthermore, 
the operator does not have to see the whole object, on the con- 

35 trary by means of interaction between the object and the sur- 
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roundings, he can get assistance in finding the correct way for 
the movement of the object. 

It should also be pointed out that the programming method can 
5 be used during execution of robot programs, whereby the op- 
erator can assist the robot in order to adjust its movement. 

An apparatus for controlling the reference values to the axle 
servo of a robot is consequently integrated with the servo sys- 
10 tern. The method according to the invention utilises this appa- 
ratus for an effective robot programming. 

The apparatus is constructed so as to give the robot axles alter- 
nating to and fro movements with a small amplitude, and in the 

15 apparatus the mean value of the motor moment required in this 
connection is compared with an expected mean value calculated 
by the apparatus. The difference or the quotient between these 
mean values forms a control moment, which either gives a posi- 
tion or speed control of the position reference to the axle servo. 

20 The expected mean value of the motor moment is calculated by 
means of a rigid body model for robot/load and/or by extrapola- 
tion of calibrated values. 

The idea of the method for the robot programming is to move 
25 around by means of the hands the robot arms/object carried by 
the robot and at suitable position/orientations of the object press 
a button or the similar so as to cause a calibration of the ex- 
pected mean value. For accurate positioning there is a further 
button or similar which makes the control system passing on 
30 from speed control to position control of the reference values to 
the axle servos. If the load (the object carried by the robot) is 
not known, it is possible to press a button or the similar so as to 
cause the identification of the load parameters. For a complete 
identification it is required that the operator turns the load be- 
35 tween two orientations and in each orientation presses the iden- 
tification button. This methodology, besides making the ma- 
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nipulation of the objects easier, also makes the programming 
itself easier than in the robot systems of today. Furthermore, the 
method of moving around robot arms/object can be used in or- 
der to during program execution, assist the robot in for instance 
5 positioning the object correctly when the conditions m the sur- 
roundings of the robots are changed. 

Brief description of the drawings 

10 With reference to the appended drawings, a more detailed de- 
scription of an embodiment of the invention, given as an exam- 
ple, will follow hereinbelow. 



15 



In the drawings 

Fig 1a is a schematic view illustrating a part of the inventional 
equipment, 

Fig 1b is a block diagram illustrating the main parts of the 
20 equipment, 

Fig 2 is a diagram showing the signal from a function generator, 
as well as the resulting moment reference signal, 

25 Fig 3 is a schematic model of a 6-axle robot projected onto a 
plane, 

Fig 4 is a schematic view associated with Fig 1a and showing 
further details of the inventional equipment, 

30 Fig 5 is a diagram illustrating functionalities of the inventional 
equipment, 

Fig 6 is a schematic view illustrating the methodology for robot 
35 programming and 
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Fig 7 is a view illustrating a control board with display designed 
as operator interface. 

Detailed description of preferred embodiment 

5 

Fig 1 shows for each of the axles of the robot a simple axle 
model 12, 13, 14, a cascade connected servo 9 and the circuits 
for reference generation to the servo during the programming 
phase 1, 8. The path generator 8 calculates position and speed 
0 references (cp re n. cpr.n) and moment feed forward control signal 
(t ffw1 ) to the servo 9. The apparatus, integrated in the servo, for 
teach-in-programming and robot manipulation consists of the 
blocks 1, 2, 3, 4, 5, 6, 7 and 18 (A+B). In order to obtain a high 
sensitivity to external interference moments during the pro- 
5 gramming, a movement pattern from the function generator 1 is 
added to the servo references, which movement pattern is of 
such a nature that the arm will make small short movements to 
and fro during the programming. These movements make that 
static friction in motor, gearing and arm bearing is continuously 
?0 overcome by the motor moment, which in its turn makes that 
external forces do' not have to overcome the friction. The func- 
tion generator 1 can generate different periodic curve shapes, 
and in Fig 1 a cut saw-tooth shape is shown as speed reference 
signal <p re f 2 . So as not to build up interfering control errors in the 
25 servo 9, a corresponding position reference cp ref2 is applied, 
which position reference is obtained by integration of (p ref 2 with 
the integrator 2. So as to make the arm follow the speed profile 
of the signal generator 1 even better, a moment feed forward 
control x ffw2 can also be added. The purpose of this moment 
30 feed forward control signal is to assist in overcoming the f no- 
tional moment for the axle, which implies that the servo 9 does 
not have to build up so large servo errors in order to generate 
the frictional moment of x m , which in its turn implies that the fre- 
quency of the periodic reference from the function generator 1 
35 can be chosen higher. The moment feed forward control signal 
Xffw2 is obtained by multiplication, in the circuit 4, of the friction 
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value t, by the sign of the speed reference <p ref . Alternatively, it 
is possible to use the sign of the real speed cp m . Possibly, the 
module 3 also has to include a delay so as to match the change 
of x ffw to the laps of time of the real friction. The friction value x, 

5 can be direction dependent and therefor the value of t f is 
switched in the module 5 between two different values depend- 
ing on the direction, i.e. depending on the sign of cp ref or <p m . The 
estimated frictional moment in positive direction is denominated 
V and in negative direction x,\ These values can either be 

10 identified at a calibration point of time or identified continuously. 
In the figure, the latter case is shown, where the identification is 
carried out in the module 7 and the identified values are sup- 
plied to the storage buffer 6. The most simple method for the 
friction identification is simply to make the following approx.ma- 

15 tion: 



V 



* T m ~ T m \2) 



20 



The measuring of x m + and x m , respectively, is suitably controlled 
by the function generator 1, but can also be controlled by the 
sign of <p m . 

25 In the figure, the servo 9 is implemented as a speed servo with 
the regulator filter 11 cascade connected with a position servo 
having the regulator filter 10. Other regulator structures can of 
course be used, and besides only measuring the axle position 
< Pm the axle speed <p m can also be measured. Furthermore, it 

30 would be possible to measure moment, arm position <p a , arm 
speed (p a and/or arm acceleration <p a . In Fig 1 , it is assumed that 
only the motor position cp m is measured and that motor speed is 
estimated by the module 16 by differentiation. 
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Moreover, 15 is the drive to the motor (with the moment con- 
stant k T ), 12 is the rotor of the motor with mass inertia Jm, the 
interference moment T distm and the friction x fm . 13 corresponds to 
the mass of the arm with the mass inertia Ja, the interference 
moment t dista and the friction x fa . Between the rotor 12 and the 
arm 13 there is a weakness (k) and a damping (c). 

The to and fro movement generated by the function generator 1 
has to be so large that the motor as well as the arm will be set 
in motion. Consequently, the feed forward control moment T ffw2 
should be given by: 



) 



*,*7-*f m + 7 XT /» (3) 

where n is the gear change of the gearing between the motor 
and the arm. In x fm the friction of the high speed side of the 
gearing should also be included and in x fa the friction of the low 
speed side of the gearing. 

In order to be able to detect and estimate the interference mo- 
ments T dista on the arm side depending on the force from the op- 
erator during manipulation of the robot, the expected interfer- 
ence moment x dis tmodei applicable without operator force is cal- 
culated in the dynamical model 17. At low speeds, it is normally 
sufficient that T distmode , only includes statical components such as 
the gravitational moment of x dista and the stator and motor nppel 
moments of T djstm . At higher speeds, the interference component 
from the centrifugal and coriolis force, viscous friction and cou- 
pled mass inertia should also be included in x d i S tmodei 

Fig 2 shows the signal <j> re f 2 (19) from the function generator 1 as 
well as the resulting moment reference signal x mr (20). At the 
point of time t dis , the interference moment (-c diS im + T dista ) is 
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changed with the value x disl2 - x dist1 , see signal 21 at the point of 
time t dis , The regulator 9 will compensate for this change in in- 
terference moment and the mean moment level of the signal t mr 
will be changed with the value x dist2 - x dist1 . When the interfer- 
ence moment level is now to be used for interpolation of the 
movement of the robot as a function of the external force with 
which the programmer of the robot presses on the robot the fol- 
lowing calculation is made in the module 18B (in f.gure 1): 



10 



15 



control 



- -T „) + T 



•(4,4) 



control 



= 1 - 



mrav 



t dist exp 



x\ alt . 



t dist exp _ ^ 



mrav 



J 



where x , r „, is the moment used by the path generator 8,x mrav 
where x con t ro is x expected interference 

the mean value of x mr , and x dis , e x P W me exp 
moment without interference moment generated by the operator. 
x d istexp is generated by the 
programming. 



| I I w i i ■ w ■ - - 

module 18A in the apparatus for robot 



l mrav 



is calculated according to: 



20 



r l ; } rJ ^ w 

l fJ t, 



since x m „ in the robot systems of today, is sampled, the integral 
is normally calculated as a mean value of discrete moment val- 
ues. 

25 The problem is now to calculate x distexp when the robot gradually 
changes its configuration (its axle angles) during the program- 
ming Here there are now two methods. The first method implies 
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15 



20 



that t is calculated from the rigid body dynamical model 17 
of the" robot w ch requires that, besides a description of the 
masses positions of centre of gravity, kinematica. relations and 
possib y main mass-moment of inertia of the robot the corre- 
sponding parameters for the load (tool, object carried by the o- 
"pping appliance) also have to be available. Since pro- 
gramming' often'takes place at low speeds anc . acce.era ions 
the gravitational moment will completely dominate x dis «exp ; and . 

on y necessary to know the mass (m L ) and the position of 
centre of gravity (X L , Y L , Z L ) of the load in relation to the at- 
tachment plate of the robot. 

The idea of the second method, which preferably is combined 
Z theVrst method, is that the robot programmer at regu.ar 
intervals releases the robot and thereupon calibrates T d ,. t exp, so 
lhat the value thereof is updated in the module 18A according 

to: 

r =- r (5) 

L dist exp ™rav 

in case of a combination of these two methods, the module 18A 
uses the interference moment x iis , mod ., calculated by the model 
17 according to: 



'dist exp ~ T disterr + T dist model 



.(6) 



25 



When the operator now releases the robot, a calibration of the 
model error T dl „. rr takes place according to: 



30 
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5 



^ mrav — ^ disterr ^ 'dist mod el 



■(7) 



__ r _ r (8) 

1 disterr ~ ^ mrav * dist mod el 

The model error can also be calculated in the module 18A as a 
correction factor: 

T dist exp ~ K err X * dist mod el 
and during calibration: 



T 

mrav 



, • (10) 

err 



efts/ mod e/ 



10 During the time when the operator is not touching the robot or 
the robot load, and identification of the load parameters (m L , x L , 
y L , z L ) can be carried out. How this is done is shown with the aid 
of figure 3. Fig 3 shows a simple dynamical model of a 6-axle 
robot projected onto a plane, which makes it easier to show the 

15 identification technique. Masses and centres of gravity (m^ r,) 
for the robot itself with the underarm 23 and the overarm 24 are 
known with high accuracy, and the mass m u and the position of 
centre of gravity (r 5mL , <pl) of the load is to be identified. From 
Fig 3, with axle angles q> 2 , cp 3 and q> 5 defined in relation to the 

20 horizontal plane, as well as the angle cp L , are obtained: 
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C - T mav2 = r 2 xm 2 x cos (p 2 +r 22 x(m 3 + tn L )xcos<p 2 (1 1) 



*mav3 =r,xm, xcos (p,+(r 25 xcos <p 3 +r 5mL xcos<p L )xm L ....(\2) 

■T maV 5=r 5mL xcos(p L xm L (13) 



where T maV i is the mean moment of the periodic moment signal 
5 20 in Fig 2 when the operator is not touching the robot. 

For a complete identification it is required that the operator 
turns the load to a new position, which gives: 



\T 



i 

mav5 



= r 5mL xo,os{<p L +k(p 5 )xrn L (14) 



10 from (12), (13) and (14) are obtained: 

-^av3 + T ma V 5 XCOS ^3 



m L = 



r 35 xcos<p 3 



.(15) 



<Pl = orctg 



sin 



(A^ 5 )' 



COS 



(A^ 5 )- 



mav5 J 



.(16) 



— T 



r 5mL 



mavs 



.(17) 



m L xcoscp L 



15 

These values are used for updating the dynamical model 17, 
which includes the mathematical description of the rigid body 
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dynamics of the robot, which is shown in a simplified embodi- 
ment in Fig 3. 

Consequently, during programming with a new load the operator 
5 should first release the robot with the axle 5 in an angle, there- 
after turn the axle 5 and subsequently release the robot again. 
The question is now how the control system will get to know 
when the operator releases the load. The most secure method is 
of course to have a press-button (64 Fig 7) or similar on the ro- 

10 bot, which the operator presses when he is no longer touching 
the robot and wants a calibration to be initiated. Another possi- 
bility is that the operator gives the robot a short push and that 
external interference moments with short duration and exceed- 
ing a certain amplitude are detected as a change-over to or from 

15 calibration state. It is of course also possible that the calibration 
is carried out when external moment interferences have been 
constant during a certain time. 

Consequently, we can now presuppose that x distexp from the 
20 module 18A accurately gives the value on the interference mo- 
ment the robot would be exposed to if the operator did not touch 
it and x contr0 i from the module 18B (according to formula 4) can 
now be used for controlling the path generation. How this control 
is performed is shown in figure 4. 

25 

According to figure 4, a non-linear transfer function 26 is applied 
to T contro) (according to formula 4), the purpose of which is to 
suppress small variations in the x contr0 i-signal. The output signal 
from 26 passes a low-pass filter 27, the purpose of which is to 

30 filter away unwanted signal noise. The output signal from 27 is 
called T contrk , where k stands for sample number of the signal. In 
the buffer 28 x contrk is delayed and on its output the previous 
sample of T contr is consequently to be found, i.e. T CO ntr(ic-i). The 
circuit 29 determines the sign of T CO ntr<k.i) and the circuit 30 the 

35 sign of x contrk . In the comparator 34 it is controlled if 29 and 30 
give different signs, in which case a reset (RES) is to be carried 
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out if the operator uses force controlled position manipulation. 
Which type of manipulation that is being used is determined by 
the state MODE, and can be changed by the operator. Besides 
position manipulation, speed manipulation can also be carried 
5 out. In this case the switch 37 is open and the switch 39 closed, 
^contrk after multiplication by k spee d in the circuit 35 being added 
to the feedback circuit with the buffer 41 and the summator 40. 
The position reference cp re f will then be changed with a speed 
being proportional to k spee d • ^contrk- If we now revert to the posi- 

10 tion manipulation mode where the switch 39 is open and the 
switch 37 is closed, T con trk will be multiplied in 33 by its sign, 
which implies that the output signal from 33 always is positive. 
The maximum value calculator 32 compares the value of the 
signal from 33 with the value from the buffer 31 and gives as 

15 output signal the maximum value I T con trmax I , which is applied to 
the buffer 31 and the multiplying circuit 36. In the latter 
Ucontrmax I is multiplied by its sign and thereby obtains the cor- 
rect sign. Furthermore, a multiplication by k pos takes place, 
which determines the relation between axle move and x cont roi. 

20 The output signal from 36 passes the mod switch 37 and is in 42 
added to the output signal from 41 for obtaining the servo refer- 
ences. If the comparator 34 detects a change of sign of T C ontr> 
the switch 38 is closed for a brief moment so that the latest po- 
sition manipulation value on the output of 36 can be added to 

25 the buffer 41, at the same time as the buffer 31 is reset. The 
latest position manipulation value is also transferred to the 
buffer 41 when a change to speed manipulation mode (the sig- 
nal MODE) takes place. The circuit 43 calculates the speed ref- 
erence to the regulator by formation of differential quotients and 

30 the circuit 44 calculates moment feed forward control by forma- 
tion of differential quotient two times and multiplication by the 
mass inertia of the axle. 

The position and speed manipulation can of course be imple- 
35 mented in several ways, but the important thing is to obtain a 
functionality according to figure 5, where the signal 46 is an ex- 
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ample of a period of time of T control , the signal 47 the resulting 
position reference in case of position manipulation and the sig- 
nal 48 the resulting position reference in case of speed ma- 
nipulation. The position manipulation is especially chosen in 
5 case of precision manipulation, whereas speed manipulation is 
chosen in case of large movements of the robot. 

The methodology for the programming when using the described 
apparatus is exemplified with the aid of figure 6 and figure 7. Let 

10 us assume that the object 50 with the hole 51 initially stands on 
the stool 53 and then is to be mounted on the beam 52 by mov- 
ing the object from the stool, turning the object 90° and there- 
after bringing the object down over the beam 52 so that the 
beam enters the hole 51 of the object 50. The operator 54 starts 

15 by switching on the robot by pressing the button 55 (figure 7) of 
the programming unit 49. This is placed by the operator e.g. on 
the gripping appliance, so that the operator during the program- 
ming easily can reach the programming unit and follow the 
movements of the robot on the graphical display 57, which pref- 

20 erably is to show the position and orientation of the object with a 
three dimensional graphic. The "tool centre point" (TCP) of the 
gripping appliance is initially in the position PO with the orienta- 
tion of the tool co-ordinate system indicated by the arrow in PO 
(Fig 7). The operator 54 now presses the button 56 

25 (PGM = programming), seizes the gripping appliance and moves 
TCP to the point P1, at the same time as he/she turns the grip- 
ping appliance. In the point P1, he/she presses the button 61 
(STR=store) and the position of the robot is stored in the stor- 
age of the control system, and P1 with associated point for TCP 

30 and arrow for orientation is now shown on the display 57. As the 
operator moves the robot, the path 58 for the movement of TCP 
is shown. After the operator has pressed on 61 in the position 
P1, he/she moves the robot to the position P2 and then posi- 
tions the gripping appliance so that it can grip the object 50. 

35 Thereupon he presses on 61 and subsequently on 66 
(GRP = grip), which results in that the gripping appliance grips 
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the object. The operator now seizes the object and lifts it from 
the stool and presses on 63 (CAL=calculate), which implies that 
tdisterr ( a,t k err) is calculated according to formula 8 (alt 10). If the 
load parameters (mass, centre of gravity) for the object 50 are 
5 not known, the operator has to assist the robot in lifting the ob- 
ject in order to overcome the unknown gravitational force of the 
object, speed control being used in this connection. Before the 
operator releases the object, he presses the button 70 
(SPD=speed POS = position) and passes on to position control, 

10 alternatively he presses the button 65 (FRC=force) and discon- 
nects the force controlled interpolator. Thereafter he presses the 
button 63, whereby T d isterr according to (8) or k err according to 
(10) is calculated. He can then press on 64 (IDNT=identification) 
for the first step in the load identification, in which case the 

15 mass of the load is calculated according to e.g. formula 15, 
press on 70 (alt 65) in order to pass into speed control, turn the 
load about an axle approximately in parallel with the horizontal 
plane, press on 70 (alt 65) and then on 64. The system now cal- 
culates all the load parameters and updates the dynamical 

20 model (compare figure 3). Thereupon, the operator presses on 
63 and Tdisterr < si 1 1 k err ) is updated since (xdistmodei) now also com- 
prises the moment components from the identified load. The op- 
erator now presses on 70 (alt 65) and can with speed control 
move the object to P3, here press on 61, move the object further 

25 on to P4, press on 61, etc. When necessary, the operator can 
press 63 (if the object is not at rest when the operator releases 
it). At the position P9, where precision is required in order to get 
the beam 52 into the hole 51, the operator suitably passes on to 
position control (button 70) before he/she presses on 61 for 

30 storing of P9. After insertion of the position P10, the operator 
presses on 65, which implies that the moment controlled ma- 
nipulation is disconnected, and thereafter on 66, the robot now 
releases the object 50. Since the gripping appliance is in off- 
state, the dynamical model is updated without load and when 

35 the operator subsequently presses on the button 65, he/she can 
return to the home position P0 in speed control mode while 
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he/she presses on 61 for P11, P12, P13 and P14. By subse- 
quently pressing on 68, he/she can run through the pickup path 
58, the object move path 59 and the return path 60. If the op- 
erator wants to adjust the path, he/she presses on 69, 56, 
5 moves the robot close to the position he/she wants to adjust, 
presses on 62 (REDO-function), moves the object to desired po- 
sition and presses on 61. With the button 67, the robot is 
switched off and its breaks are activated. 

10 The button 71 has a particular function. It is used for program- 
ming a reference direction, along which the robot during pro- 
gram execution can use weakness regulation or force control. If 
e.g. the position of the rod 52 is different in different assembly 
operations, the programmed program has to be adjusted from 

15 time to time in the positions P9 and P10. How large this adjust- 
ment is to be can be calculated by reading the robot axle angles 
when the robot in e.g. two different directions in the horizontal 
plane presses the object 50 with a defined force against the rod 
52. 

20 

Another way of adapting the movements of the robot to varying 
conditions in the surroundings is that an operator assists the ro- 
bot during the program execution when the robot works in the 
production. This can be exemplified in figure 6 and 7 by the ro- 

25 bot running according to the programmed path to e.g. the posi- 
tion P8. Here the robot stops and the operator steps forward, 
presses on the button 56, adjusts with his hands the position 
and orientation of the object 50 until the rod 52 is directly under 
the hole 51, presses on the button 72, the rest of the pro- 

30 grammed positions now being corrected (position, orientation) 
just as much as the operator has adjusted the object manually. 
Thereafter the operator presses on the button 68 and the cor- 
rected program is executed. In this way, an assistant robot is 
obtained, which can assist the operator in e.g. heavy lifts, in 

35 generating large assembly forces and in performing difficult 
movements. 
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The exemplifying embodiment is of course not to be regarded as 
limiting for the inventional idea. Several modifications conse- 
quently occur for men skilled in the art, when the basic inven- 
5 tional solution has been presented. Such modifications are com- 
prised within the scope of the invention, as well as equivalent 
embodiments. It is particularly pointed out that the invention has 
been illustrated in the drawing in principal. The illustration tech- 
nique has in certain aspects been chosen in order to simplify the 
10 understanding. As an example it is pointed out that the two de- 
vices 18A and 18B are illustrated as separated. In reality they 
can of course be semi-detached or otherwise integrated. 
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1. An equipment for controlling an industrial robot, which robot 
has a plurality of rotation and/or translation axles (ax 1-6), 
the equipment comprising: 

- at least one motor (12,15) at each of said axles for generat- 
ing desired movements of the arms (23, 24, 25) and/or the 
wrist, of which the robot is constituted, 

- at least one sensor at each of the axles for measuring axle 
angle and/or axle position, 

- at least one servo (9) for each of the axles for controlling the 
motors based on measurement values from the sensors, 

- at least one path generator (8) for generating at least one 
reference (cp re f, <p re f Jffw) for each of the servos (9), 

characterized in that the equipment comprises an apparatus 
(1+2+3+4+5+6+7+ {parts of 8} +18A +18B) at at least one of the 
axles, which apparatus comprises a first device (18A) for calcu- 
lation of the expected interference moment value (T diste xp) of said 
axle when the movable parts of the robot is not exposed to any 
external forces by interaction with the operator (64) or other 
things in the surroundings of the robot, and a second device 
(18B) for comparing this expected interference moment value 
(tdistexp) with values of the moment reference (x mr ) of the servo 
(9) and/or with values of the moment (t m ) of the motor and/or 
with values of moment measured on the axle (14) with sensors 
and for forming, based on this comparison, a signal (x C ontroi) for 
controlling the path generator (8). 

2. An equipment according to claim 1, characterized in a func- 
tion generator (1) included in said apparatus for supplying to 
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the servo (9) at least one reference signal (cp ref2 and/or (p ref2 
and/or T ffw2 ) for generating a to and fro motion of the axle 
controlled by the servo, and means for calculation of said 
values of the moment reference (i m ) of the servo (9) and/or of 
5 the moment (T m ) of the motor and/or the moment of the axle 
(14) by mean value formation (in the unit 18B according to 
formula 4B). 

3. An equipment according to claim 2, characterized in that the 
10 function generator (1) is arranged to generate a periodic sig- 
nal and that means (in the unit 18B according to formula 4B) 
for forming the mean value is arranged to form this mean 
value over at least one period (tj to t j+1 ) of this signal. 

15 4. An equipment according to claim 2, characterized in that the 
apparatus comprises devices (2, 3, 4) for generating, from 
the output signal of the function generator (1), position and 
speed references (cp r ef2» <Pref2) and moment feed forward con- 
trol reference (t ffw2 ) to the servo (9), the feed forward control 

20 reference (T ffW 2) being formed by multiplication (in the device 
4) of the estimated frictional moment (x f ) and the sign (from 
the device 3) of the speed reference ((p re f) or the speed (<j> m ) 
for the axle in question. 

25 5. An equipment according to claim 4, characterized in that a 
device (7) is arranged to calculate the estimated frictional 
moment by identification of the frictional moment either at a 
particular calibration occasion or during the robot program- 
ming by measuring the motor moment reference (x mr ) at at 

30 least two different points of time, at which points of time the 
motor axle has different directions of rotation (formula 2), and 
that a storage buffer (6) is arranged to receive the identified 
frictional moment values (x f ) for later use during generation of 
the moment feed forward control reference (if fW 2)- 

35 
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6. An equipment according to claim 1, characterized in that the 
expected interference moment value (x djstexp ) given by the first 
device (18A) consists of the interference moment (x djstmode( ) of 
the robot axle in question calculated in the rigid body dy- 

5 namical model (17) for the robot, comprising mainly the mo- 
ment on the axle caused by the gravitation (compare the for- 
mulas 1 1-14). 

7. An equipment according to claim 1, characterized in that the 
10 first device (18A) is arranged to set the expected interference 

moment value (x djstex p) equal to the value of the moment ref- 
erence (x mr ) of the servo (9) and/or of the moment (x m ) of the 
motor and/or of the moment measured on the axle (formula 
5), when the movable parts of the robot are not exposed to 
15 any external forces by interaction with the operator (64) or 
any other things in the surroundings of the robot. 

8. An equipment according to claim 6, characterized in means 
for determining the error (x dist err, K err ) of the interference mo- 

20 ment (x distrTloc jei) of the robot axle in question calculated in the 
rigid body dynamical model (17) by calibration against the 
moment reference (x mr ) of the servo and/or against the mo- 
ment (x m ) of the motor and/or against the moment (formula 8, 
10) measured on the axle, when the movable parts of the ro- 

25 bot (including gripping appliance, object and/or tool) are not 
exposed to any external forces by interaction with the opera- 
tor (64) or any other things in the surroundings of the robot. 

9. An equipment according to claim 8 and 2, characterized in 
30 that said apparatus for at least one of said axles comprises a 

device (18A) for calculating the expected mean value (x djste xp) 
as the sum of said model error (x disterr ) and the model calcu- 
lated interference moment (x distmode i, see formula 6), said 
model error (x djste rr) being determined by calibration against 
35 one of the moment mean values (x mrav ) when the movable 
parts of the robot (including gripping appliance, object and/or 
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tool) are not exposed to any external forces by interaction 
with the operator (64) or any other things in the surroundings 
of the robot, and that the model error (x disterr ) during the cali- 
bration is calculated as the difference between model calcu- 
lated interference moment (x distmodel ) and prevailing moment 
mean value (x mrav , formula 8). 

10. An equipment according to claim 8 and 2, character- 
ized in that the apparatus for at least one of the axles com- 
prises a device (18A) for calculating said expected mean 
value (T diste xp) as the product of the model error (K err ) and the 
model calculated interference moment (T distmode!j see formula 
9), and that the model error (K err ) is determined by calibration 
against one of the moment mean values (x mrav ) when the 
movable parts of the robot (including gripping appliance, ob- 
ject and/or tool) are not exposed to any external forces by 
interaction with the operator (64) or any other things in the 
surroundings of the robot, and that the model error (K err ) 
during the calibration is calculated as the quotient between 
prevailing moment mean value (x mrav ) and the model calcu- 
lated interference moment (x distmod ei, see formula 10). 

11. An equipment according to claims 6 and 8-10, charac- 
terized in that the equipment comprises a device (17B) for 
identification of at least the load parameters mass (m L ) and 
position of centre of gravity (X L , Y L , Z L ) of gripping appliance 
and/or object and/or tool carried by the robot, and the utilisa- 
tion of the identified load parameters for a more accurate cal- 
culation of the model calculated interference moment (x dist - 
modeb see formula 15-17). 

12. An equipment according to claim 7, characterized in 
that the second device (18B) is arranged to calculate the sig- 
nal (x controi ) for controlling the path generator as the differ- 
ence between expected interference moment (T distexp ) and ei- 
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ther of said servo, motor or axle moment (x mrav , see formula 
4A). 

13. An equipment according to claim 1, characterized in 
5 that the second device (18B) is arranged to calculate said 

signal (x con troi) for controlling the path generator as one minus 
the quotient between either of said servo, motor or axle mo- 
ment (x mrav ) and expected interference moment (T djste xp), al- 
ternatively as the quotient between expected interference 
10 moment (T djste xp) and either of said servo, motor and axle 
moment (x mrav ) after that the quotient has been reduced by 1 
(see formula 4B). 

14. An equipment according to claim 1, characterized in 
15 that the path generator (8) is arranged to use said signal 

(^control) for controlling the path generator in order to calculate 
servo references (cp ref1 , (p re fijffwi) by forming a speed refer- 
ence component as a function of the size of the control signal 
(^control) and/or a position reference component as a function 
20 of the size of the control signal (x contr0 |). 

15. An equipment according to claim 14, characterized in 
that said speed component is calculated by multiplication 
(35) of said control signal (x contr0 i) by a constant (k spee d). 

25 

16. An equipment according to claim 14, characterized in 
that said position reference component is calculated by mul- 
tiplication (in 36) of a local maximum of said control signal 
(tcontrmax) by a constant (k pos ). 

30 

17. An equipment according to claim 1, characterized in 
that said control signal (x controj ) passes through a non-linear 
function (26) and/or a low-pass filter and/or a band-pass fil- 
ter. 



35 
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18. A method for programming and/or for adjusting the 
movement of a robot by utilisation of the equipment described 
in claims 1-17, characterized in that 

5 - the operator manipulates the arms of the robot by interaction 
with the arms of the robot and/or tool, gripping appliance 
and/or object carried by the robot, 

- the operator has the use of an operator interface (49), which 
by the operator can be attached at a suitable place on the ro- 

10 bot, tool, gripping appliance, object or things in the sur- 
roundings of the robot, 

- the operator utilises said operator interface (49) by press- 
button and/or voice interface in order to give said equipment 
the orders required for obtaining the desired function of the 

15 described apparatus (1, 2, 3, 4, 5, 6, 7, 8, 17B, 18A and 
18B). 

19. A method according to claim 18, characterized in 
that the operator with said press-button and/or voice inter- 

20 face gives orders for calibration of the expected interference 
moment (T d j Stexp , press-button 63). 

20. A method according to claim 18, characterized in 
that the operator with said interface gives orders for switch- 

25 ing between speed and position control (MODE, press-button 

70). 

21. A method according to claim 28, characterized in 
that the operator with said interface gives orders for identifi- 

30 cation of the load carried by the robot (press-button 64). 

22. A method according to claim 18, characterized in 
that the operator gives orders for connecting up of or discon- 
nection of moment control (x C ontroi) of the path generator 

35 (press-button 65). 
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23. A method according claim 18, characterized in that 

the operator gives orders for marking a programmed position 
as auxiliary position for calculating the direction during force 
control (press-button 71). 
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